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(54) A method for airbourne transfer alignment of an inertial measurement unit 



(57) A method for determining the initial conditions 
for an inertial measurement unit (IMU) of a second ve- 
hicle launched from a wing of a first vehicle is provided. 
The method includes the steps of defining a state vector 
x as including (a) the rotation £ of the computed coordi- 
nate axes with respect to the real coordinate axes of the 
second vehicle and (b) the projection 5a along the Z axis 
of the first vehicle of the rotation of the second vehicle 
from its nominal coordinate axes to its real coordinate 



axes. A measurement z is defined as the projection 8p 
of a rotation angle ft along the Z axis of the first vehicle, 
between the nominal coordinate axes and a current 
computed coordinate axes. The method also includes 
the steps of estimating x over time with a Kalman filter, 
wherein the projection 5ji is the measurement vector 
and the state vector x changes only due to random noise 
and processing x to produce the attitude about the Z axis 
of the first vehicle. 
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FIELD OF THE INVENTION 

The present invention relates to in-flight alignment of inertial measurement units (IMUs) generally and, in particular, 
to alignment of an IMU of a second vehicle which is attached to a first vehicle. 

BACKGROUND OF THE INVENTION 



^ io Airplanes often carry with them other flying vehicles, such as smaller airplanes or missiles, which are to be launched 

during flight. The second vehicle typically is located on the wing of the first vehicle. Both vehicles have inertial meas- 
(f) urement units (IMUs) on them for determining their inertial locations. 

UJ In order to operate, IMUs require to know the initial position, velocity and attitude of the vehicle with respect to 

CC some predefined coordinate system. 

15 During flight, the navigation system of the main vehicle continually operates to determine the attitude, velocity and 

position of the vehicle. Before the second vehicle is launched, the main vehicle provides the initial conditions to the 
IMUs of the second vehicle. As long as the exact position, velocity and attitude of the second vehicle with respect to 
the main vehicle are known and as long as the current values are accurate, the second vehicle will receive an accurate 
set of initial conditions. 

20 However, the output of the IMU on the second vehicle tends to drift (i.e. lose accuracy) over time and, more im- 

portantly, due to vibrations in flight, the second vehicle might rotate from its nominal position. If the extent of the rotation 
is not compensated, the IMU output of the second vehicle will not be reliable. 

The rotation can be estimated by performing a maneuver which excites lateral acceleration. The output of both 
sets of IMUs are compared and the angle of rotation of the second vehicle vis-a-vis the main vehicle is determined. 

25 pitch and roll angles are not difficult to estimate. However, the standard maneuver for yaw estimation, illustrated 

in Fig. 1 to which reference is now made, requires curving in and out along a curve 12, horizontal to the ground 10. 
Pilots generally do not like to perform such a maneuver just prior to releasing the second vehicle. However, without it, 
the navigation system of the second vehicle is not properly calibrated. 



30 SUMMARY OF THE PRESENT INVENTION 



Applicant has realized that, for second vehicles attached onto the wings of the main vehicle, the rotation of the 
second vehicle is typically caused by movement of the wings. Applicant has further realized that the wings can flap up 
and down (pitch) and can rotate about their main axis (roll) but they cannot rotate around the vertical (Z) axis simply 

35 due to how the wings are built. In other words, the yaw angle of the wings does not change. 

Therefore, the yaw calibration flight maneuver can be performed at any time during the flight, to determine the yaw 
rotation as measured by the IMU of the second vehicle. Since the second vehicle does not rotate in the yaw direction, 
any difference from the output of the IMU of the first vehicle is due to drift only. The pitch and roll information is updated 
without any specific maneuvers. 

40 it is therefore an object of the present invention to provide a method for determining initial conditions, in the yaw 

direction, for the IMU of the second vehicle. 

In accordance with the present invention, there is provided a method for determining the initial conditions for an 
inertial measurement unit (IMU) of a second vehicle to be launched from a wing of a first vehicle. The method includes 
the steps of defining a state vector x as including (a) the rotation £ of the computed coordinate axes with respect to 

45 the real coordinate axes of the second vehicle and (b) the projection 6a along the Z axis of the first vehicle of the 
rotation of the second vehicle from its nominal coordinate axes to its real coordinate axes. A measurement z is defined 
as the projection 8p of a rotation angle p, along the Z axis of the first vehicle, between the nominal coordinate axes 
and a current computed coordinate axes. The method also includes the steps of estimating x over time with a Kalman 
filter, wherein the projection 8p is the measurement vector and the state vector x changes only due to random noise 

50 and processing x to produce the attitude about the Z axis of the first vehicle. 

Furthermore, in accordance with the present invention, the projection 5(5 of angle p is determined from the following 
measurements: 

a. the quaternion q L:A representing the relative attitude from the LLLN axes to the main airplane A axes; 

55 

b. the quaternion q A: NOM representing the relative attitude from the main airplane A axes to the nominal, second 
vehicle axes B NOM ; 
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c. the quaternion q L . c representing the relative attitude from the LLLN axes to the computed second vehicle axes 

d. the direction cosine matrix C NOM:A defining the rotation from Bn OM to the main airplane axes A; and 

e. the direction cosine matrix C L:A defining the rotation from LLLN to the main airplane axes A. 

Furthermore, in accordance with the present invention, the step of Kalman filtering utilizes the following measure- 
ment equation: 



* = [ClaW> C la( 3:2 >> c la&& 



Cz 
6a 



Additionally, in accordance with the present invention, there is provided a method for determining the initial con- 
ditions for an inertial measurement unit (IMU) of a second vehicle to be launched from a wing of a first vehicle which 
utilizes the fact that the wing has no rotation about the Z axis of the first vehicle, and therefore, the second vehicle 
does not rotate about the Z axis of the first vehicle. 

BRIEF DESCRIPTION OF THE DRAWINGS 

The present invention will be understood and appreciated more fully from the following detailed description taken 
in conjunction with the drawings in which: 

Fig. 1 is a schematic illustration of a prior art yaw maneuver; 

Fig. 2 is a schematic illustration of a main airplane with a second vehicle attached thereto, useful in understanding 
the present invention; 

Fig. 3A is a schematic illustration of the coordinate axes of the main airplane and the nominal axes of the second 
vehicle of Fig. 2; 

Fig. 3B is a schematic illustration of the coordinate axes of the main airplane and the actual axes of the second 
vehicle of Fig. 2; 

Fig. 4A is a schematic illustration of the rotation from the nominal to the actual axes of the second vehicle; 

Fig. 4B is a schematic illustration of the projection of the rotation quaternion which describes the rotation of Fig. 
4A onto the Z axis of the main airplane; and 

Fig. 5 is a schematic illustration showing the relationships of lour coordinate axes, that of the main airplane and 
the nominal, actual and computed axes of the second vehicle. 

DETAILED DESCRIPTION OF A PREFERRED EMBODIMENT 

Reference is now made to Figs. 2, 3A, 3B, 4A, 4B and 5 which are useful in understanding the present invention. 

Fig. 2 illustrates a main airplane 20 having a second vehicle 22 attached to its wing 24. Shown also are the coor- 
dinate system 26 of the main airplane 20 and the rotation angles pitch 0, roll $ and yaw vy, where pitch 9 is a rotation 
about the Y axis, roll $ is a rotation about the X axis and yaw y is a rotation about the Z axis. 

Applicant has realized that the rotation of the second vehicle is typically caused by movement of the wings. Ap- 
plicant has further realized that the wings can flap up and down (pitch) and can rotate about their main axis (roll) but 
they cannot rotate around the vertical (Z) axis simply due to how the wings are built. In other words, during flight, the 
yaw angle of the wings does not change. 
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The present invention is a system for determining the initial conditbns of the IMU of the second vehicle and it 
utilizes the fact that, physically, there is no yaw rotation. In the present invention, the pilot needs to perform the yaw 
maneuver only once, at any point during his flight, to determine the yaw angle of the second vehicle 22 vis-a-vis the 
main vehicle 20. Since the wing does not yaw, there should be no changes in the yaw angle measured by the IMUs 
of the second vehicle 22 after the yaw maneuver is performed. The present invention constantly measures any drift in 
the yaw angle determined by the IMU. The roll and pitch initial values are taken in the same manner as in the prior art. 

Fig. 3A illustrates the coordinate axes A of the main vehicle 20 and Bn OM of the nominal attitude of second vehicle 
22 prior to calibration. Fig. 3B illustrates the coordinate axes A of the main vehicle 20 and the real axes B R of the 
second vehicle 22 during flight. The coordinate axes A of the main vehicle 20 are known since its navigation system 
10 is accurate. The nominal axes B NOM of the second vehicle 22 are known since they are nominally known prior to flight. 
The real axes B R of the second vehicle 22 are to be found. 

There is a fourth set of axes B c (not shown) which is the computed set. It is rotated from the real axes B R by a 
vector £= K x , £ yi C z ] ( not shown) given in local level local north (LLLN) axes. 

As can be seen in Fig. 4A, the actual coordinate axes B R are rotated from the nominal, coordinate axes B^ 0M by 
15 an amount q which is a quaternion. The rotation of the second vehicle 22 about the Z axis of the main airplane 20 is 
represented by the projection a of the quaternion q along the Z axis, Z a , c , of the main vehicle 20. "a" is illustrated in 
Fig. 4B. 

Fig. 5 illustrates the relationship among the four different coordinate axes where the arrows indicate the positive 
directions. The main airplane axes A and the nominal second vehicle IMU axes Bm OM are rotated from each other by 
20 ihe measured angle a and the angle from the main airplane axes A to the real second vehicle IMU axes B R is (a + 8a) 
where 8a is unknown. The computed axes Be are rotated from the nominal axes B NOM by an angle 5(3. 

The angle from B R to B c is defined as -5^ which is the projection of the vector £ = [£ x , £ y , £ z ] onto the Z 9lc axis. 
In accordance with a preferred embodiment of the present invention, the angle of the second vehicle 22 vis-a-vis 
the main vehicle 20 might not be the same as the value (a) given prior to flight. The diff erence : along the Z axis of the 
25 main airplane, is noted 5a and is a fixed value. 5a is estimated with an extended Kalman Filter as are the domputed 
angles, £ x , £ y and £ 2 , between the computed second vehicle IMU axes and the real axes. If the state vector is: 



30 



35 



X = 



c, 

6a 



(1) 



the continuous system model is given by: 



40 



X = Ax + w 



(2) 



A=[0] 



(3) 



45 where [0] is a 4x4 matrix full of zeros and w is a four element, normal, distributed, zero mean, white noise vector. In 
other words, the states change only because of random noise. 

The measurement model for the extended Kalman Filter is given by: 

so z = Hx + v (4) 

where z and H are as defined hereinbelow and v is a normal, distributed, zero mean : white noise element. 
The following measurement information is available: 

55 1) the quaternion q L:A representing the relative attitude from the LLLN axes to the main airplane A axes; 

2) the quaternion c^nqm representing the relative attitude from the main airplane A axes to the nominal, second 
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vehicle axes B NOM ; 



15 



3) the quaternion q L . c representing the relative attitude from the LLLN axes to the computed second vehicle axes 
B c ; 

5 

4) the direction cosine matrix C NOM:A defining the rotation from Bn OM to the main airplane axes A; and 

5) the direction cosine matrix C L:A defining the rotation from LLLN to the main airplane axes A. 
10 Quaternion mathematics produces: 

°lL:NOM = ^LA * ^A:NOM ^ 
^C:NOM = %:L * ^L:A * ^AiNOM (6) 

The attitude error from axes B c to axes B NOM is typically small and is given, in B NOM axes, as: 

Px = 2 ^c:nom0) < 7 > 
P y = 2*q C:NOM (2) (8) 

30 where q C: NOM(0 is the itn element of the quaternion q C: NOM- 

The projection of p jt j = x.y.z, onto the axis is -5p and is determined as follows: 



20 



25 



35 



(10) 

Pv 



40 

where C NOM . A (3,) denotes the third row of the nominal direction cosine matrix C NOM:A .-8p is a measurement. It therefore 
forms the measurement element z. 

Referring back to Fig. 5, the following statement can be made: 

45 

angle (B c toB R )= 5^ = 5a - Sp (11) 

or: 

so 

■6p = 5^-6a (12) 

or 

ss 

z=HC-8a (13) 



5 



EP 0 744 590 A2 

where projects the vector £ from the LLLN axes to the axis. Now: 



(14) 



Hence, the measurement of equation 1 3. is given by: 



z = [C^(3,l), C^(3:2), C^(3,3) -1] . 



6a 



(15) 



model for the Kaeman filter is provided in equations 1 - 4 and the measurement equation is provided in equation 4, 
repeated hereinbelow. 



z = Hx + v 



(16) 



It is noted that z is a one-dimensional element having the value of -5p and the matrix H is given by: 



H = [C L:A (3 S 1), C L:A (3,2), C L:A (3,3) -1] 



(17) 



A priori knowledge of the aircraft operation should be utilized lo determine the white noise characteristics of vari- 
ables v and w. 

In accordance with the present invention, a Kalman Filter using the model of equations 1 - 4 and 16 is implemented 
and estimates thereby the values for x. 

It will be appreciated by persons skilled in the art that the present invention is not limited to what has been partic- 
ularly shown and described hereinabove. Ratherthe scope of the present invention is defined by the claims which follow: 



Claims 

1. A method for determining the initial conditions for an inertial measurement unit (IMU) of a second vehicle to be 
launched from a wing of a first vehicle, the method comprising the steps of: 

a. defining a state vector x as including (a) the rotation £ of the computed coordinate axes with respect to the 
real coordinate axes of the second vehicle and (b) the projection 5a along the Z axis of the first vehicle of the 
rotation of the second vehicle from its nominal coordinate axes to its real coordinate axes; 

b. determining a measurement z as the projection 5p of a rotation angle p, along the Z axis of the first vehicle, 
between the nominal coordinate axes and a current computed coordinate axes, both axes being of the second 
vehicle; 

c. estimating x over time with a Kalman filter, wherein said projection 5p is the measurement vector and said 
state vector x changes only due to random noise; 

d. processing x to produce the attitude about the Z axis ol said first vehicle. 

2. A method according to claim 1 and wherein said projection 5(3 of angle p is determined from the following meas- 
urements: 
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a. the quaternion q L . A representing the relative attitude from the LLLN axes to the main airplane A axes; 

b. the quaternion q A:N oM representing the relative attitude from the main airplane A axes to the nominal, second 
vehicle axes B NO m» 

c. the quaternion q L . c representing the relative attitude from the LLLN axes to the computed second vehicle 
axes B c ; 

d. the direction cosine matrix C N0M:A defining the rotation from B N0M to the main airplane axes A; and 

e. the direction cosine matrix C L:A defining the rotation from LLLN to the main airplane axes A; according to 
the following equation: 

-8P = 2 * C NOM A (3,*) . q C:NOM . 

A method according to claim 2 and wherein said step of Kalman filtering utilizes the following measurement equa- 
tion: 



z = [C,.X3,l), C L J3:2), C^(3,3) "U • 



A method for determining the initial conditions for an inertial measurement unit (IMU) of a second vehicle to be 
launched from a wing of a first vehicle which utilizes the fact that said wing has no rotation about the Z axis of the 
first vehicle, and therefore, the second vehicle does not rotate about the 2 axis of the first vehicle. 
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